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IN THE CLAIMS 
LISTING OF CLAIMS 

1 Claim 1 (withdrawn): A method of tracking the orientation of a sensor, the 

2 method comprising: 

3 a) measuring an angular velocity of the sensor to generate angular 

4 rate values; 

5 b) integrating the angular rate values; 

6 c) normalizing the integrated angular rate values to produce an 

7 estimate of sensor orientation; 

8 d) measuring a magnetic field vector to generate local magnetic 

9 field vector values; 

10 e) measuring an acceleration vector to generate local gravity vector 
n values; and 

12 f) correcting the estimate of sensor orientation using the local 

13 magnetic field vector and local gravity vector. 

1 Claim 2 (withdrawn): A method of tracking as in Claim 1 wherein correcting 

2 the estimate of sensor orientation using the local magnetic field vector and 

3 local gravity vector comprises: 

4 g) determining a measurement vector from the local magnetic field 

5 vector values and the local gravity vector values; 

6 h) calculating a computed measurement vector from the estimate of 

7 sensor orientation; 

8 i) comparing the measurement vector with the computed 

9 measurement vector to generate an error vector that defines a criterion 

10 function; 

1 1 j) performing a mathematical operation that results in the 

12 minimization of the criterion function and outputs an error estimate; 

13 k) integrating the error estimate; 

14 1) normalizing the integrated error estimate to produce a new 

15 estimate of sensor orientation; and 
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16 m) repeating steps a)-m), wherein the new estimate of sensor 

17 orientation is used for h), calculating a computed measurement vector until 

18 tracking is no longer desired. 

1 Claim 3 (withdrawn): The method of Claim 2 wherein the operation of j), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises minimizing the criterion function without 

4 calculating the criterion function. 

1 Claim 4 (withdrawn): The method of Claim 2 wherein the operation of j), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function includes implementing a partial correction step to 

4 compensate for measurement error. 

1 Claim 5 (currently amended): The m e thod o f Claim 4 wh e r e in im p lem e ntin g 

2 th e p a rt ial co rr ec t i o n step to comp e nsat e fo r m e asu r ement e rr o r is 

3 suppl e mented by using a weighted least squares reg r essi o n to emphasiz e 

4 m or e re liabl e m e asurem e nts with r e spect to less r eliable measu re ments . 

5 A method of tracking the orientation of a sensor, the method comprising : 

6 a^ measuring an angular velocity of the sensor to generate angula r 

7 rate values: 

8 b) integrating the angular rate values: 

9 c) normalizing the integrated angular rate values to produce a n 

10 estimate of sensor orientation: 

11 d) measuring a magnetic field vector to generate local magneti c 

12 field vector values: 

13 e) measuring an acceleration vector to generate local gravity vecto r 

14 values: and 

15 f) correcting the estimate of sensor orientation using the loca l 

16 magnetic field vector and local gravity vector . 

17 wherein correcting the estimate of sensor orientation using the loca l 
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v 

is magnetic field vector and local gravity vector comprises : 

19 g) determining a measurement vector from the local magnetic fiel d 

20 vector values and the local gravity vector values ; 

21 h) calculating a computed measurement vector from the estimate o f 

22 sensor orientation: 

23 i) comparing the measurement vector with th e computed 

24 measurement vector to generate an error vector that defines a criterio n 

25 function: 

26 )) performing a mathematical operation that results in th e 

27 minimization of the criterion function and outputs an error estimate : 

28 wherein the operation of performing a mathematical operatio n 

29 that results in the minimization of the criterion function includes implementi ng 

30 a partial correction step to compensate for measurement error : 

31 wherein implementing the partial correction step to compensat e 

32 for measurement error is supplemented bv using a weighted least square s 

33 regression to emphasize more reliable measurements with respect to les s 

34 reliable measurements: 

35 k) integrating the error estimate: 

36 1) normalizing the integrated error estimate to produce a new 

37 estimate of sensor orientation: and 

38 rri) repeating steps aVml wherein the new estimate of senso r 

39 orientation is used for hV calculating a computed measurement vector unt il 

40 tracking is no longer desired . 

1 Claims 6 (withdrawn): The method of Claim 2 wherein the operation of j), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises using time weighted filtering. 

1 Claim 7 (withdrawn): The method of Claim 2 wherein the operation of g)> 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises using a Gauss-Newton iteration. 
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1 Claim 8 (withdrawn): A method of tracking the orientation of a sensor, the 

2 method comprising: 

3 a) measuring an angular velocity of the sensor to generate an 

4 angular rate quaternion; 

5 b) integrating the angular rate quaternion; 

6 c) normalizing the integrated angular rate quaternion to produce an 

7 estimated sensor orientation quaternion; and 

8 d) measuring a magnetic field vector to generate local magnetic 

9 field vector values; 

10 e) measuring an acceleration vector to generate local gravity vector 
n values; 

12 f) correcting the estimated sensor orientation quaternion using the 

13 local magnetic field vector and local gravity vector. 

1 Claim 9 (withdrawn): A method of tracking as in Claim 8 wherein correcting 

2 the estimated sensor orientation quaternion using the local magnetic field 

3 vector and local gravity vector comprises: 

4 g) determining a measurement vector from the local magnetic field 

5 vector values and the local gravity vector values; 

6 h) calculating a computed measurement vector from the estimated 

7 sensor orientation quaternion; 

8 i) comparing the measurement vector with the computed 

9 measurement vector to generate an error vector that defines a criterion 

10 function; 

11 j) performing a mathematical operation that results in the 

12 minimization of the criterion function and outputs an error estimate 

13 quaternion; 

14 k) integrating the error estimate quaternion; 

is 1) normalizing the integrated error estimate quaternion to produce a 

16 new estimated sensor orientation quaternion; and 
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17 m) repeating steps a)-m), wherein the new estimated sensor 

18 orientation quaternion is used for h), calculating a computed measurement 

19 vector. 

1 Claim 1 0 (withdrawn): The method of Claim 9 wherein the operation of j), 

2 performing a mathematical operation that results in the minimization of the _ 

3 criterion function comprises minimizing the criterion function without 

4 calculating the criterion function. 

1 Claim 1 1 (withdrawn): The method of Claim 9 wherein the operation of j), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function includes implementing a partial correction step to 

4 compensate for measurement error. 

1 Claim 1 2 (currently amended): The method of Claim 10 wherein 

2 implementing the partial cor r ec t ion step t o compensat e for measurement erro r 

3 is supplem e nted by using a w e ighted least squares r e gression to em p hasiz e 

4 mor e r eliable measu r ements with res p ect to less r eliabl e measuremen ts 

5 A method of tracking the orientation of a sensor, the method comprising : 

6 a) measuring an angular velocity of the sensor to generate a n 

7 angular rate quaternion: 

8 b) integrating the angular rate quaternion: 

9 c) normalizing the integrated angular rate quaternion to produce a n 

10 estimated sensor orientation quaternion: and 

11 d) measuring a magnetic field vector to generate local magneti c 

12 field vector values; 

13 e^ measuring an acceleration vector to generate local gravity vecto r 

14 values: 

15 f) correcting the estimated sensor orientation quaternion using th e 

16 local magnetic field vector and local gravity vector : 

17 wherein correcting the estimated sensor ori entation quaternion 
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is using the local magnetic field vector and local pravitv vector comprise s: 

19 determining a measurement vector from the local magnetic fiel d 

20 vector values and the local gravity vector values : 

21 Yi) calculating a computed measurement vector from the estimate d 

22 sensor orientation quaternion ; 

23 \) comparing the measurement vector with the compute d 

24 measurement vector to generate an error vector that defines a criterio n 

25 function: 

26 i) performing a mathematical operation that results in th e 

27 minimization of the criterion function and outputs an error estima te 

28 quaternion: 

29 wherein the operation of performing a mathematical operation tha t 

30 results in the minimization of the criterion function comprises minimizing t he 

31 criterion function without calculating the criterion function : 

32 wherein the operation of performing a mathematical operation tha t 

33 results in the minimization of the criterion function includ es implementing a 

34 partial correction step to compensate for measurement error ; 

35 wherein implementing the partial correction step to compensate fo r 

36 measurement error is supplemented by using a weighted least square s 

37 regression to emphasize more reliable measurements with respect to les s 

38 reliable mea surements: 

39 10 integrating the error estimate quaternion: 

40 Y) normalizing the integrated error estimate quaternion to produce a 

41 new estimated sensor orientation quaternion: and 

42 m) repeating steps aVml wherein the new estimated senso r 

43 orientation quaternion is used for hi calculating a computed measuremen t 

44 vector. 

1 Claims 1 3 (withdrawn): The method of Claim 9 wherein the operation of j), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises using time weighted filtering. 

7 
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1 Claim 14 (withdrawn): The method of Claim 9 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises using a Gauss-Newton iteration. 

1 Claim 15 (withdrawn): A method of tracking the orientation of a sensor, the 

2 method comprising: 

3 a) providing a starting estimate of sensor orientation; 

4 b) measuring a magnetic field vector to generate local magnetic 

5 field vector values; 

6 c) measuring an acceleration vector to generate local gravity vector 

7 values; 

g d) determining a measurement vector from the local magnetic field 

9 vector values and the local gravity vector values; 

10 e) calculating a computed measurement vector from the estimate of 
n sensor orientation; 

12 f) comparing the measurement vector with the computed 

13 measurement vector to generate an error vector that defines a criterion 

14 function; 

is g) performing a mathematical operation that results in the 

16 minimization of the criterion function and outputs an error estimate; 

17 h) integrating the error estimate; 

is i) normalizing the integrated error estimate to produce a new 

19 estimate of sensor orientation; and 

20 j) repeating steps a)-j), wherein the new estimate of sensor 

21 orientation is used for e), calculating a computed measurement vector. 

1 Claim 1 6 (withdrawn): The method of Claim 1 5 wherein each new estimate 

2 of sensor orientation is output as a sensor orientation signal. 

1 Claim 1 7 (withdrawn): The method of Claim 1 5 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

8 
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3 criterion function comprises minimizing the criterion function without 

4 calculating the criterion function. 

1 Claim 18 (withdrawn): The method of Claim 15 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function includes implementing a partial correction step to 

4 compensate for measurement error. 

1 Claim 1 9 (currently amended): The method of Claim 18 whe r ei n 

2 impl e menting th e partial cor re ction st ep to compensate for m e asurement error 

3 is su pp l e men t ed by using a w e ighted leas t squares regression to emphasiz e 

4 mo re re liable measurements with respect t o l e ss reliabl e measur e m e n t s . 

5 A method of tracking the orientation of a sensor, the method comprising : 

6 a) providing a starting estimate of sensor orientation : 

i b) measuring a magnetic fi eld vector to generate local magnetic 

s field vector values: 

9 c) measuring an acceleration vector to generate local gravity vecto r 

10 values; 

n d) determining a measurement vector from the local magnetic fiel d 

12 vector values and the local gravity vector values : 

13 e) calculating a computed measurement vector from the estimate o f 

14 sensor orientation; 

15 f) comparing the measurement vector with the compute d 

16 measurement vector to generate an error vector that defines a criterio n 

17 function; 

18 g) performing a mathematical operation that results in th e 

19 minimization of the criterion function and outputs an error estimate : 

20 wherein the operation of performing a mathematical operation tha t 

21 results in the minimization of the criterion function includes implementing a 

22 partial correction step to compensate for measurement error: 

23 wherein implementing the partial correction step to compensate fo r 
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24 measurement error is supplemented bv using a weight ed least squares 

25 regression to emphasize more reliable measurements w ith respect to less 

26 reliable measurements; 

27 h) integrating the error estimate: 

28 i) normalizing the integrated error estimate to produce a new 

29 estimate of sensor orientation: and 

30 \) repeating steps aVi V wherein the new estimate of senso r 

31 orientation is used for eV calculating a computed measurement vector. 

1 Claims 20 (withdrawn): The method of Claim 1 5 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises using time weighted filtering, 

1 Claim 21 (withdrawn): The method of Claim 15 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function comprises using a Gauss-Newton iteration. 

1 Claim 22 (withdrawn): The method of Claim 1 5 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs an error estimate includes: 

4 measuring an angular velocity of the sensor to generate angular rate 

5 values; 

6 integrating the angular rate values; 

7 normalizing the integrated angular rate values to produce an estimate of 

8 sensor orientation derived from the angular rate values; and 

9 using the estimate of sensor orientation derived from the angular rate 

10 values to correct for time lag. 

1 Claim 23 (withdrawn): A method of tracking the orientation of a sensor, the 

2 method comprising: 

3 a) providing a starting estimate of sensor orientation quaternion; 
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4 b) measuring a magnetic field vector to generate local magnetic 

5 field vector values; 

6 c) measuring an acceleration vector to generate local gravity vector 

7 values; 

8 d) determining a measurement vector from the local magnetic field 

9 vector values and the local gravity vector values; 

10 e) calculating a computed measurement vector from the estimate of 
u sensor orientation, using quaternion mathematics; 

12 f) comparing the measurement vector with the computed 

13 measurement vector to generate an 6x1 error vector that defines a criterion 
u function; 

15 g) performing a mathematical operation that results in the 

16 minimization of the criterion function and outputs a 4x1 quaternion error 

17 estimate; 

18 h) integrating the quaternion error estimate; and 

19 i) normalizing the integrated quaternion error estimate to produce a 

20 new estimated sensor orientation quaternion; 

21 j) repeating steps a)-j), wherein the new estimated sensor 

22 orientation quaternion is used for e), calculating a computed measurement 

23 vector. 

1 Claim 24 (withdrawn): The method of Claim 23 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs a 4x1 quaternion error estimate comprises 

4 minimizing the criterion function without calculating the criterion function. 

1 Claim 25 (withdrawn): The method of Claim 23 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs a 4x1 quaternion error estimate comprises 

4 multiplying the 6x1 error vector by the function [XX^X 7 . 
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1 Claim 26 (withdrawn): The method of Claim 23 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs a 4x1 quaternion error estimate further includes 

4 implementing a partial correction step to compensate for measurement error. 

1 Claim 27 (withdrawn): The method of Claim 23 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs a 4x1 quaternion error estimate comprises using 

4 a time weighted filtering system. 

1 Claim 28 (withdrawn): The method of Claim 23 wherein the operation of g)> 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs a 4x1 quaternion error estimate comprises using 

4 a Gauss-Newton iteration. 

1 Claim 29 (currently amended). The method uf Claim 26 wherein 

2 implem e nting the pa r tial correc t ion step to compensate for measurement e rror 

3 is supplemented by using a weighted least squares r cg ic &si u n t o emphasiz e 

4 more relia b le measurements with respect to less reliable measurement s 

5 A method of tracking the orientation of a sensor, the method comprising : 

6 al providing a starting estimate of sensor orientation quaternion : 

7 b> measuring a magnetic field vector to generate local magneti c 

8 field vector values: 

9 c) measuring an acceleration vector to generate local g ravity vector 

10 values: 

11 d^ determining a measurement vector from the local magnetic fiel d 

12 vector values and the local gravity vector values : 

13 .e) calculating a computed measurement vector from the estimate of 

14 sensor orientation, using quaternion mathematics : 

is f) comparing the measurement vector with the compute d 

16 measurement vector to generate an 6x1 error vector that defines a criterion 

12 
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17 function: 

is g) performing a mathematical operation that results in th e 

19 minimization of the criterion function and outputs a 4x1 quaternion err or 

20 estimate: 

21 wherein the operation of g), performing a mathematical operation tha t 

22 results in the minimization of the criterion function and outputs a 4x 1 

23 quaternion error estimate further includes implementing a partial correctio n 

24 step to compensate for measurement error: 

25 wherein implementing the partial correction step to compensate fo r 

26 measurement error is supplemented bv using a weighted least square s 

27 regression to emphasize more reliable measurements with respect to les s 

28 reliable measurements: . . . — 

29 h) integrating the quaternion error estimate: 

30 i) normalizing the integrated quaternion error estimate to produce a 

31 new estimated sensor orientation quaternion: and 

32 repeatine steps aVi). wherein the new estimated senso r 

33 orientation quaternion is used for e\ calculating a computed measuremen t 

34 vector. 

1 Claim 30 (withdrawn): The method of Claim 23 wherein the operation of g), 

2 performing a mathematical operation that results in the minimization of the 

3 criterion function and outputs a 4x1 quaternion error estimate includes: 

4 measuring an angular velocity of the sensor to generate an angular rate 

5 quaternion; 

6 integrating the angular rate quaternion; 

7 normalizing the integrated angular rate quaternion to produce an 

8 estimate of sensor orientation quaternion derived from the angular rate 

9 quaternion; and 

10 using the estimate of sensor orientation quaternion derived from the 

1 1 angular rate quaternion to correct for time lag. 

l Claim 31 (withdrawn): A sensor apparatus comprising: 

13 
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2 a magnetic field detector configured to measure a magnetic field vector 

3 and output a local magnetic field vector signal; and 

4 an acceleration detector configured to detect a local gravitational field 

5 vector and output a local gravitational field vector signal. 

1 Claim 32 (withdrawn): The sensor of Claim 3 1 , further includes an angular 

2 velocity detector configured to detect an angular velocity vector of the sensor 

3 and output angular velocity signal. 

1 Claim 33 (withdrawn): The sensor of Claim 32 wherein, the angular rate 

2 detector comprises a three-axis angular velocity detector; the magnetic field 

3 detector comprises a three-axis magnetometer; and the acceleration detector 

4 comprises a three-axis accelerometer. 

1 Claim 34 (withdrawn): The sensor of Claim 31 wherein the sensor includes at 

2 least one processor that receives and processes the signals from the magnetic 

3 field detector and the acceleration detector to determine the orientation of the 

4 sensor apparatus. 

1 Claim 35 (withdrawn): The sensor of Claim 32 wherein the sensor includes at 

2 least one processor that receives and processes the signals from the magnetic 

3 field detector, the acceleration detector, and the signal from the angular 

4 velocity detector, wherein the at least one processor is configured to 

5 determine the orientation of the sensor. 

1 Claim 36 (withdrawn): A system for tracking the posture and orientation of 

2 body, the system comprising: 

3 the body having mounted thereon at least one sensor; 

4 each sensor including a magnetometer for measuring a magnetic field 

5 vector and a acceleration detector for measuring a body acceleration vector, 

6 and 

7 at least one processor for receiving input from the magnetometer and 

14 
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8 acceleration detector and using said input to calculate a local magnetic field 

9 vector and a local gravity vector and to determine the orientation of the body. 

1 Claim 37 (withdrawn): A system as in Claim 36 wherein the at least one 

2 processor is configured input the body orientation information into a synthetic 

3 environment; and 

4 wherein the system further includes a display for displaying the 

5 position and orientation of the body with respect to the synthetic environment. 

1 Claim 38 (withdrawn): A system as in Claim 37 wherein the at least one 

2 processor is configured to correct for the offset between sensor coordinates 

3 and body coordinates. 

1 Claim 39 (withdrawn): A system as in Claim 36 wherein each sensor further 

2 includes an angular velocity detector for measuring a body angular velocity 

3 vector. 

1 Claim 40 (withdrawn): A system as in Claim 39 wherein the at least one 

2 processing is configured input the body orientation information into a 

3 synthetic environment; and 

4 wherein the system further includes a display for displaying the 

5 position and orientation of the body with respect to the synthetic environment. 

1 Claim 41 (withdrawn): A system as in Claim 40 wherein the at least one 

2 processor is configured to correct for the offset between sensor coordinates 

3 and body coordinates. 

1 Claim 42 (withdrawn): A system as in Claim 36 wherein the body comprises 

2 an articulated rigid body having a plurality of segments interconnected by at 

3 least one joint and wherein each segment has mounted thereon at least one 

4 sensor. 
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1 Claim 43 (withdrawn): A system as in Claim 39 wherein the body comprises 

2 an articulated rigid body having a plurality of segments interconnected by at 

3 least one joint and wherein each segment has mounted thereon at least one 

4 sensor. 

Claim 44 (withdrawn): A method of determining the direction of a local 
gravity vector with an acceleration detector, the method comprising: 

moving the acceleration detector from a start point to an end point over 
a time period; 

taking measurements of the total acceleration vector during the time 
period; 

weighted summing the measurements of the total acceleration vector 
over the time period; and 

calculating gravity vector values using the weighted sum of the total 
acceleration measurements. 
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ADDED NEW CLAIMS 



1 Claim 45 (new): A method of tracking the orientation of a sensor, the method 

2 comprising: 

3 a) measuring a magnetic field vector to generate local magnetic field 

4 vector values; 

5 b) measuring an acceleration vector to generate local gravity vector 

6 values; 

7 c) determining a measurement vector from the local magnetic field vector 

8 values and the local gravity vector values; 

9 d) calculating a computed measurement vector from the estimate of sensor 

10 orientation 

l i e) comparing the measurement vector with the computed measurement 

12 vector to generate an error vector that defines a criterion function; and 

13 f) performing a mathematical operation that results in the minimization of 

14 the criterion function usin greduced order Gauss-Newton iteration. 

1 Claim 46 (new). A method of tracking as in Claim 45 wherein the reduced 

2 order Gauss-Newton iteration of Claim I takes into account that there are only 

3 three independent elements in a quaternion. 

1 Claim 47 (new). A method of tracking as in Claim 45 wherein the reduced 

2 order Gauss-Newton iteration requires the inversion of a matrix with a 

3 dimensionality of no more than 3x3. 

1 Claim 48 (new). A method of tracking as in Claim 45 wherein the reduced 

2 order Gauss-Newton iteration utilizes a reduced order 6 x 33T matrix entirely 

3 composed of elements of the computed measurement vector. 

1 Claim 49 (new). A method of tracking the orientation of a body limb segment 

2 of a tracked subject compared to sensor orientation, comprising: 

3 a) determining a correction to compensate for the difference 

17 
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4 




between sensor coordinates and body limb segment coordinates; 


5 


b) 


placing the tracked subject in a single predetermined reference 


6 




nosition* 


7 


c) 


wherein the body limb segment axes are aligned with 


8 




corresponding Earth-fixed axes or differ by a known offset; and 


9 


d) 


wherein the correction found while the tracked subject is in the 


10 




predetermined reference position consists of the inverse of the 


11 . 




orientation reported by the sensor and the inverse of any known 


12 




offset. 
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Allowance and passage to issue at an early date are respectfully requested. 
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Respectfully submitted, 



ERIC R. BACHMANN 
ROBERT B. McGHEE 
XIAOPING YUN 
MICHAEL J. ZYDA 
DOUGLAS L. McKINNEY 
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